/*
 * To change this license header, choose License Headers in Project Properties.
 * To change this template file, choose Tools | Templates
 * and open the template in the editor.
 */
package edu.wpi.first.wpilibj.templates.commands;

import edu.wpi.first.wpilibj.command.CommandGroup;

/**
 *
 * @author Robotics
 */
public class AutonomousCommand_CG extends CommandGroup {
    
    public double distanceFromWall = 0;
    
    public AutonomousCommand_CG() {
        // Add Commands here:
        // e.g. addSequential(new Command1());
        //      addSequential(new Command2());
        // these will run in order.

        // To run multiple commands at the same time,
        // use addParallel()
        // e.g. addParallel(new Command1());
        //      addSequential(new Command2());
        // Command1 and Command2 will run in parallel.
        // A command group will require all of the subsystems that each member
        // would require.
        // e.g. if Command1 requires chassis, and Command2 requires arm,
        // a CommandGroup containing them would require both the chassis and the
        // arm.
        //addSquential(new WaitForHotTarget(distance,seconds)); 
        //add wait for hot target command, wait six seconds
        /*timeLeft = 10 - ((System.currentTimeMillis() - startTime) / 1000);
        if(timeLeft >= 5){
            addParallel(new DetectTargets(timeLeft, distanceFromWall));
        }*/
        addSequential(new AutonomousDetectDrive_CG());
        addSequential(new TimedShootCatapult_CG(true));
        //addParallel(new TargetTimedShooter_CG(timeLeft, distanceFromWall));
    }
}
